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Abstract — This  paper  focuses  on  the  problem  of  developing 
control  laws  to  solve  the  Time-Coordinated  3D  Path-Following 
task  for  multiple  quadrotor  UAVs  in  the  presence  of  time- 
varying  communication  networks  and  spatial  and  temporal 
constraints.  The  objective  is  to  enable  a  fleet  of  quadrotors 
to  track  predefined  spatial  paths  while  coordinating  to  achieve 
synchronization  in  both  time  and  heading.  One  scenario  is  a 
symmetric  exchange  of  position  by  four  quadrotors  initially 
positioned  in  four  corners  of  a  square  room.  When  the  mission 
starts,  every  quadrotor  is  required  to  execute  collision  free 
maneuvers  and  arrive  at  the  opposite  corner  at  the  same  desired 
instant  of  time.  In  this  paper,  the  time-coordination  task  is 
solved  by  adjusting  the  second  derivative  of  the  coordination 
variable  along  the  desired  paths.  Conditions  are  derived  under 
which  the  coordination  and  path-following  errors  converge  to 
a  neighborhood  of  zero.  Flight  test  results  are  presented  to 
validate  the  theoretical  findings. 

I.  Introduction 

Avoiding  harm’s  ways  requires  the  employment  of  in¬ 
telligent  autonomous  vehicles.  This,  along  with  recent  ad¬ 
vances  in  miniature  technology,  brings  a  global  spotlight 
on  the  development  of  Unmanned  Aerial  Vehicles  (UAVs). 
Currently,  the  use  of  UAVs  plays  a  crucial  role  in  pre¬ 
venting  exposure  of  human  beings  to  uncertain  and  hostile 
environments,  therefore  avoiding  any  danger  to  the  lives  of 
operators.  For  instance,  after  being  struck  by  the  biggest 
recorded  earthquake  and  a  devastating  tsunami,  Japan  has 
been  fighting  a  potential  nuclear  catastrophe  by  deploying 
UAVs  in  situations  where  the  presence  of  human  operators 
was  hazardous. 

From  a  design  point  of  view,  and  with  a  slight  abuse  of 
terminology,  UAVs  can  be  classified  in  two  main  categories: 
fixed-wings  and  rotatory-wings.  Compared  to  the  fixed-wings 
-which  cannot  freely  move  in  any  direction  (rotate)  or 
hold  a  constant  position-,  rotorcrafts  can  be  deployed  in 
a  much  wider  variety  of  scenarios.  Among  rotatory-wings 
aircraft,  quadrotors  play  an  important  role  in  research  areas 
as  prototypes  for  real-life  missions,  including  monitoring  and 
exploration  of  small  areas. 

A  quadrotor  consists  of  four  blades,  whose  motion  control 
is  achieved  by  adjusting  the  angular  rate  of  one  or  more 
rotor  discs.  Control  of  quadrotors  is  quite  challenging  and 
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has  been  addressed  in  many  recent  publications.  To  mention 
a  few,  in  [1]  and  [2]  a  stabilization  and  control  algorithm 
is  developed  using  Lyapunov  stability  theory.  In  [3]  and  [4] 
PD2  and  PID  architectures  are  compared  with  LQR  based 
control  theory.  Backstepping  control  is  proposed  in  [5], 
while  in  [6]  and  [7]  a  visual-based  feedback  control  law  is 
presented  using  camera  measurements  for  pose  estimation. 
Fuzzy-logic  control  techniques  are  proposed  in  [8],  Intelli¬ 
gent  control,  based  on  neural  networks,  is  introduced  in  [9] 
to  achieve  vertical  take-off  and  landing.  Integral  sliding  mode 
and  reinforcement  learning  control  are  presented  in  [10] 
as  solutions  for  accommodating  the  nonlinear  disturbances 
for  outdoor  altitude  control.  Finally,  in  [11]  a  trajectory¬ 
tracking  control  algorithm  is  formulated  using  the  Special 
Orthogonal  group  S0(3)  for  attitude  representation,  leading 
to  a  simple  and  singularity-free  solution  for  the  trajectory 
tracking  problem. 

Cooperation  between  multiple  unmanned  vehicles  has  also 
received  significant  attention  in  the  control  community  in 
recent  years.  Relevant  work  includes  spacecraft  formation 
flying  [12],  UAV  control  [13],  [14],  coordinated  control 
of  land  robots  [15],  and  control  of  multiple  autonomous 
underwater  vehicles  [16],  [17].  However,  much  work  remains 
to  be  done  to  overcome  numerous  critical  constraints.  For 
example,  one  of  the  crucial  problems  is  the  presence  of  time- 
varying  communication  networks  that  arise  due  to  temporary 
loss  of  communication  links  and  switching  communication 
topologies  [18],  [19]. 

Motivated  by  these  challenges,  we  address  the  problem 
of  Time-Coordinated  3D  Path-Following  (TCPF),  where  a 
set  of  quadrotor  UAVs  are  requested  to  converge  to  and 
follow  desired  prespecified  paths  under  stringent  temporal 
constraints.  In  the  solution  adopted,  the  path-following  (PF) 
and  time-coordination  (TC)  problems  are  almost  decoupled. 
At  the  PF  level,  we  assume  there  exists  a  control  law  capable 
of  steering  a  quadrotor  along  its  assigned  path.  At  the  TC 
level,  the  synchronization  problem  is  solved  by  adjusting 
the  commanded  position  and  velocity  of  the  quadrotors 
involved  in  the  mission,  thus  obtaining  -indirectly-  vehicle 
coordination.  Figure  1  captures  the  key  concept  described 
above. 

This  paper  is  organized  as  follows.  In  Section  II,  we 
define  the  PF  and  TC  control  problems,  and  present  stability- 
related  properties  that  the  PF  closed-loop  system  must  sat¬ 
isfy.  Then,  a  formal  definition  of  the  TCPF  problem  is 
given.  In  Section  III  we  propose  a  solution  for  the  TC  prob¬ 
lem.  Section  IV  formulates  a  PF  algorithm  that  enables  an 
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Fig.  1.  TCPF  Control  Scheme. 


AR. Drone  quadrotor  to  follow  a  desired  path,  and  shows  that 
the  convergence  properties  of  the  TCPF  system  hold  for  this 
particular  vehicle.  Section  V  presents  and  discusses  flight 
tests  results  that  illustrate  the  effectiveness  of  the  proposed 
PF  and  TC  algorithms.  Finally,  Section  VI  contains  the  main 
conclusions. 


body-fixed  frame  Bp,  Rd,i  £  SO(3)  represents  the  desired 
attitude  of  the  ith  quadrotor  with  respect  to  the  inertial  frame 
and  is  generally  expressed  as  a  function  of  the  position  and 
velocity  errors,  ex>i  and  e,,vl,  as  well  as  the  desired  head¬ 
ing  'i/jd.,1,  ^d,i  satisfies  S(£ld)  =  while  the  operators 

(•)v  and  S(-)  denote  the  vee  and  hat  maps  [11]. 

With  the  above  notation,  we  define  the  path-following 
generalized  error  vector 


XpF,i  = 


eR,i  ■ 


eQ,i 


p  12 


(6) 


The  dynamics  of  the  ith  vehicle’s  PF  error  vector  can  be 
modeled  as 

XPF,i  =  fi(Xpp,i,Ui)  ,  (7) 


where  /*(■)  is  a  general  nonlinear  vector  map  and  ut  is  the 
control  signal  vector.  Then,  the  PF  control  problem  can  be 
defined  as: 

Problem  1  (Path-Following  Problem):  Consider  the 
ith  quadrotor  UAV  and  a  given  trajectory  Xd,i(  7») 
satisfying  (1).  We  say  that  a  controller  Ui(t)  solves  the 
PF  control  problem  if  the  generalized  PF  error  vector  xpF,i 
with  the  dynamic  described  in  (7)  satisfies 


II.  Problem  Formulation 
A.  3D  Path-Following  for  a  single  quadrotor 

Let  I  denote  an  inertial  reference  frame,  and 
let  Xi(t)  £  R3  be  the  position  of  the  center  of  mass 
of  the  ith  quadrotor  in  this  inertial  frame,  resolved  in  X. 
Also,  let  Bi  =  {6i,  62,  ^3}  denote  the  body  frame  with  its 
origin  located  at  the  center  of  mass  of  the  ith  quadrotor; 
vector  63  is  normal  to  the  plane  defined  by  the  centers  of  the 
four  rotors  -pointing  upwards  in  non-inverted  flight-,  while 
vectors  b\  and  62  lie  in  this  plane,  with  h\  pointing  out  the 
nose  and  62  completing  the  right-hand  system.  Further,  let 
Xd,i(li)  £  R3  be  a  desired  path  parameterized  by  7 and 
assume  that 

dxd,i 

n  L  IV max, 2  j  (t/ 

v'Yi 

for  some  0  <  tv  max,  t  <  umax,  where  vmax  is  the  maximum 
operational  speed  of  the  quadrotors.  The  choice  of  the 
parameterizing  variable  7$  will  be  discussed  later. 

Then,  we  can  define  the  position  error  vector  as 

ex,i  =  av,i(7i)  -  Xi  £  R3  (2) 

and  the  velocity  error  vector  as 

_  &X,i,i{'fi)  .  .  _  .  /  \  .  in)3  ™ 

&v,i  —  r\  T i  G  M.  .  (3) 

Additionally,  similar  to  [11],  define  the  errors 

eR,i  =  2  ~~  Ri  Rd.,i)  ;  (4) 

Rd,i^ld,i  ?  (5) 

where  R,  £  S0(3)  and  f  1,  £  R3  are,  respectively,  the  ro¬ 
tation  matrix  from  the  body-fixed  frame  Bi  to  the  inertial 
frame  X  and  the  angular  velocity  of  the  ith  quadrotor  in  the 


||*PF,i(f)||  <  fc||a;pF,i(0)||e  Xppt , 

for  some  parameter  k  >  0,  rate  of  convergence  Xpf  >  0,  and 
domain  of  attraction 

D  =  {xpf,i  £  R12  :  ||a;p.F,i||  <  r},  r>  0. 

Assumption  1:  We  assume  that  there  exists  a  control  law 
Ui(t)  that  solves  the  PF  problem  defined  in  Problem  1. 

B.  Time-Coordination 

We  now  address  the  TC  problem  of  a  fleet  of  n  quadrotor 
UAVs.  As  will  become  clear,  this  problem  will  be  solved 
by  adjusting  -for  each  vehicle-  the  second  derivative  of  the 
parameterizing  variable  7 i(t). 

As  described  earlier,  the  desired  path  assigned  to  each 
vehicle  is  parameterized  by  a  variable  7$,  i  =  1, . . . ,  n.  The 
choice  of  the  parameter  7*  is  such  that,  if  7,  (t )  —  7 j  (t)  =  0, 
Vi,j  £  {1  i  j  and  7 *(f)  =  1,  Vi  £  {l,...,n}, 

at  some  time  t,  then  all  the  vehicles  are  synchronized  and 
evolve  at  the  desired  speed. 

To  achieve  synchronization,  the  coordination  variables  7* 
have  to  be  exchanged  among  the  quadrotors  over  a  sup¬ 
porting  communications  network.  Using  tools  from  graph 
theory,  we  can  model  the  information  flow  as  well  as  the 
constraints  imposed  by  the  communication  topology.  We  start 
by  assuming  that  the  ith  UAV  communicates  only  with  a 
neighboring  set  of  vehicles,  denoted  by  A/];.  We  also  assume 
that  the  communication  between  two  UAVs  is  bidirectional 
with  no  delays.  The  reader  is  referred  to  [20]  for  key  concepts 
and  details  on  algebraic  graph  theory. 

Following  the  notation  used  in  [21],  we  now  let 
L(t)  £  R”xra  be  the  Laplacian  of  the  graph  F(f). 
Let  Q  £  jR(ra— 1)xrl  be  a  matrix  such  that  Qln  =  0, 
QQT  =  In- 1,  and  define  L(t)  =  QL(t)QT\  it  can  be  shown 


that  L  £  has  the  same  spectrum  as  the  Lapla- 

cian  L(t)  without  the  eigenvalue  Ai  =  0.  Finally,  we  let  L(t) 
satisfy  the  persistency  of  excitation  (PE)  assumption: 

rt-\-T 

J  L(t)cLt  >  fjl„- 1 .  (8) 

Next,  letting  7(f)  =  [71(f), . . .  ,7 „(t)]T 

and  7 (f)  =  [71(f),  ■  •  •  ,7n(f)]T,  we  define  the  coordination 
error  vectors 

m  =  Qi{t)  £  M"-1 ,  (9) 

z(t)  =  7  (t)  -In  61”.  (10) 

From  the  definition  of  Q  it  follows  that,  if  £(f)  =  0„, 
then  7 i  —  7j  =  0,  Vi,  j  £  {1, . . . ,  n}.  Note  that  convergence 
of  z(t)  to  zero  implies  that  the  individual  parameterizing 
variables  £i(t)  evolve  at  the  desired  rate  1. 

With  the  above  notation,  the  coordination  problem  can 
now  be  defined  as: 

Problem  2  (Time-Coordination  Problem ):  Given  a  set  of 
n  3D  desired  trajectories  design  feedback  control 

laws  for  7 j  for  all  vehicles  such  that  the  coordination 
error  vectors  £  and  z,  defined  in  (9)  and  (10)  respectively, 
converge  exponentially  to  a  neighborhood  of  zero  with  rate 
of  convergence  A tc  >  0. 

C.  Time-Coordinated  3D  Path-Following 

Considering  the  PF  and  TC  problems  described  above,  we 
can  now  define  the  combined  TCPF  control  problem  for  a 
fleet  of  quadrotor  UAVs. 

Problem  3  (Time-Coordinated  Path-Following  Problem): 
Consider  a  set  of  n  quadrotor  UAVs  and  a  set  of 
n  3D  desired  trajectories  Xd,i(7i).  Assume  the  quadrotors  can 
communicate  over  a  communications  network  satisfying  (8). 
Design  feedback  control  laws  Ui  (f )  and  7 *  (f )  such  that 

1)  for  each  vehicle,  the  generalized  PF  error  vec¬ 
tor  x  p  pr  (f  )  defined  in  (6)  converges  to  a  neighborhood 
of  zero; 

2)  the  coordination  error  vectors  defined  in  (9)  and  (10) 
converge  exponentially  to  zero. 

III.  Time-Coordinated  3D  Path-Following: 

Main  Result 

To  solve  the  TCPF  problem,  we  let  the  evolution  of  7*0) 
be  given  by 

7 i  =  ~Hii  ~  1)  -  «  (7*  ~  7 j)  -dai(xPFti) , 

jeA/i 

7*  (0)  =  0 ,  7i(0)  =  l, 


with  5  being  a  positive  design  parameter.  The  dynamics  of 
7  (f)  can  be  written  in  compact  form  as 

7  =  -  aLy  -  da(xPF ) ,  7(0)  =  0„,  7(0)  =  1„  , 

(11) 

where 


XPF  —  [%PF, li  •  ■  •  !  xPF,n]T  C  M1”"  , 

a(xpF )  =  [ai(xpF.l),  •  •  •  ,  an{xpF,n)\T  G  • 

Then,  the  Lemma  below  states  the  main  result  of  this 
paper: 

Lemma  1:  Consider  a  set  of  n  quadrotor  UAVs  and  a  set 
of  n  3D  desired  trajectories  Xd,i( 7i).  Given  n  PF  algorithms 
satisfying  Assumption  1  and  the  coordination  control  law 
described  in  (11),  then  there  exist  control  gains  a,  b,  d,  and  6 
that  solve  the  TCPF  control  problem  3.  In  particular,  it  can  be 
shown  that  the  vector  xtcpf  =  [x~pF ,  £T,  zT]T  converges 
exponentially  fast  to  a  neighborhood  of  zero  with  rate  of 
convergence 

A  =  min(ApF  ,  A  tc)  ,  (12) 


where 


A  TC  < 


F 

2T(l  +  n2T)2  ’ 


and  with  domain  of  attraction 


(13) 


Dc  =  {xtcpf  £  R14”  1  :  [|£pF,i||  <  r}  .  (14) 

Proof.  An  outline  of  the  proof  is  given  in  the  Appendix.  □ 
Remark  1:  The  rate  of  convergence  A pp  depends  on  the 
properties  of  the  adopted  PF  control  law.  If  the  PF  control 
law  has  a  rate  of  convergence  greater  than  A  tc,  then  the  rate 
of  convergence  of  the  TCPF  system  is  equal  to  the  rate  of 
convergence  of  the  TC  algorithm. 

Remark  2:  Note  that  the  rate  of  convergence  of  the  TC  al¬ 
gorithm  strictly  depends  on  the  quality  of  the  communication 
network  (parameters  //  and  T). 


IV.  Illustrative  example:  TCPF  with  AR. Drones 

To  test  the  performance  of  the  algorithm  presented  in  the 
previous  section,  we  adopted  the  flying  robot  architecture 
realized  by  Parrot  AR. Drone  company.  To  this  end,  we  first 
developed  a  PF  algorithm  that  satisfies  the  conditions  de¬ 
scribed  in  Section  II  and  that  uses  the  control  input  provided 
by  the  AR.Drone  autopilot,  which  accepts  control  commands 
for  linear  velocity  along  the  inertial  vertical  channel  i,  Euler 
angles  6  and  (j)  for  the  horizontal  motion,  and  yaw  rate  tp. 
Next,  we  reformulate  the  PF  problem  presented  in  Section  II 
for  this  particular  platform,  and  derive  a  PF  algorithm  based 
on  simple  linear  control. 

A.  PF  Error  Dynamics 


where  a,  b,  d  are  positive  coordination  control  gains,  while 
dii(xpF.i)  is  defined  as 

%d,iex,i  xJ^eV:i 

[|zd,i||+<5  Hid.iH  +  <5  ’ 


For  simplicity,  we  write  separately  the  horizontal  and 
vertical  motions: 


x  =  [(IIx)T,  eJx]T  , 
v  =  [(nn)T,  eJv]T  , 


Oii{xpF,i) 


where  v  =  x,  while  II  and  e3  are  defined  as 


'o' 

'1 

0 

o' 

0 

1 

0 

1  e3  = 

0 

1 

Therefore,  the  dynamics  of  the  quadrotor  can  be  written  as 
follows: 


H  : 

V  : 


Ili  =  ITu 
IK  =  Yl—Re3 

ejx  =  ejv 

ejv  =  e3™Re3~9 


(15) 


where  R  can  be  expressed  in  terms  of  the  Euler  angles  as: 


R  —  R^RqRt/j 

c9cip  scjisOcil)  —  ccpsip  ccps9cip  +  scpstp 
=  c9sip  s(ps9sip  +  ccpcip  ccps9sip  —  scpcip 
—s9  s<p>c9  ccpc9 

Since  the  AR.Drone  autopilot  is  designed  to  operate  using 
small  angle  commands  in  (p  and  9,  we  can  linearize  the 
dynamics  in  (15)  to  obtain: 


n 


V 


Cip  —sip 
sip  cip 


[-VI 


(16) 


x  =  eoV 


to  u  —  —  —  Q 
'j  m  a 

Next,  define  the  horizontal  position  and  velocity  errors  as 


eXXy  =  n  (xd  -  X )  ,  (17) 

ev*y  =  n^d  -  x) .  (18) 

Similarly,  define  the  vertical  position  and  velocity  errors  as 

eXz  =  e 3  ixd  -  X)  ,  (19) 

eVz  =  e3  (®d  -  X)  .  (20) 


Also,  let  ep  be  defined  as  in  (4)  with  Rd  =  R^,RgR^d.  This 
implies  that 

Rd  R  =  R<p  R<t>  RsRip 

= 

c{lpd  -  VO  s(V>d  -  Ip)  0 

=  -s(ipd  -  4>)  c(ijjd  -  Ip)  0  , 

0  0  1 

thus  leading  to 

0 

eR=  0 

-s{ipd  -  VO. 

Ignoring  the  first  two  components  of  e^,  we  define 


=  —s(ipd  —  ip)  SM. 


If  we  now  consider  small  heading  deviations  with  respect  to 
the  desired  value  ipd,  then  c.,j,  can  be  approximated  by 

=  ip  —  ipd  ■  (21) 


Finally,  define  the  generalized  PF  error  vector  as 


x 


*  _ 

PF  ~ 


e 


T 

Vxy 


e^]T  e  R6 


(22) 


Notice  that,  in  contrast  to  the  general  formulation  in  Sec¬ 
tion  II,  the  generalized  error  vector  defined  here  does  not 
consider  the  error  states  eVz  and  en.  This  is  due  to  the 
fact  that  these  two  error  signals  are  directly  controlled  by 
the  AR. drone  autopilot,  ensuring  their  convergence  to  a 
neighborhood  of  zero. 

With  this  in  mind,  we  can  now  write  the  PF  error  dynamics 
as 


[  ^Xxy 
J  ^Vxy 


where 

Ui 


ev*v  > 

II xd  -  ( ejv  +  g ) 
ej  ±d-U2, 

U3-1pd, 


cip  —sip 
sip  cip 


U 1 , 


[-</,]  ,  U2  =  ejv,  u3  =  ip 


(23) 


are  the  command  signals  accepted  by  the  AR.drone  autopilot. 


B.  PF  Control  Law 


Before  we  define  the  PF  control  law  for  the  AR.drone 
quadrotor,  we  make  the  following  assumption. 

Assumption  2:  The  PID  controller  of  the  AR.drone  au¬ 
topilot  responsible  for  z  control  is  tuned  to  ensure  that 


ejv+g  >  0. 

With  this  assumption,  we  can  now  define  the  control  inputs 

Mi,  U2,  and  M3  as 


Ml  = 


(e3  *+s) 
,T 


cip  sip 
—sip  cip 


(najd 


+  kdS-Vx y)  ) 


U2  =  e3  xd  +  kzex 

M3  —  ^pd  kijjCijj  , 


(24) 


where  kp,  kd,  kz,  and  k.,:,  are  positive  control  gains.  Then,  it 
can  be  shown  that  the  origin  of  the  PF  error  dynamics  (23)  is 
(locally)  exponentially  stable.  The  next  lemma  summarizes 
this  result. 

Lemma  2:  Consider  an  AR.drone  quadrotor  and  a  desired 
path  Xd{ 7).  Let  the  command  signals  of  the  AR.drone 
autopliot  be  given  by  (24)  and  assume  ||i,i||  <  Mmax.  Then, 
for  any  A pF  >  0,  there  exist  control  gains  kp,  kd,  kz,  and  fcy, 
such  that  the  error  vector  defined  in  (22)  satisfies 


bPF 


<  fc||a;pF(0)||e 


-At 


within  some  domain  of  attraction 


D  =  {x*PFeR6  :  ||^F||  <  r*}  ,  (25) 


where  the  linearization  of  the  quadrotor  dynamics  is  valid. 

Proof.  The  proof  of  this  result  is  omitted  due  to  space 
limitations.  □ 


Corollary  1:  Consider  a  set  of  n  AR. Drone  quadrotors 
and  a  set  of  n  3D  desired  trajectories  Xd,i(ji)-  Given 
n  PF  algorithms  proposed  in  Lemma  2  and  the  coordination 
control  law  described  in  (11),  there  exist  control  gains  a,  b. 


d ,  and  S  that  solve  the  TCPF  control  problem  3  with  rate  of 
convergence 

A  =  min(ApF  ,  \TC) , 
where  \*PF  is  defined  in  Lemma  2  and 

A TC  <  - — - 

Tc  2T(1  +  n2T)2  ’ 
and  with  domain  of  attraction 


3D  trajectories 


(a)  Desired  and  actual  orbits. 


D*c  =  {sTCPf  G  K8"  1  :  ||a:pF,i||  <  f*}  •  (26) 

Remark  3:  The  bound  r*  in  (25)  for  which  the  lineariza¬ 
tion  of  the  quadrotor  dynamics  is  valid  will  depend  on  the 
choice  of  the  control  gains  kp,  kd,  kz,  and  k^.  A  relation 
between  these  control  gains  and  r*  can  be  obtained  from  the 
control  laws  in  (24). 

V.  Flight  test  results 

In  this  section,  we  present  flight  tests  results  of  two 
AR. Drone  quadrotors  that  are  tasked  to  follow  circular, 
planar  paths  of  radius  2  m  at  a  constant  speed,  while 
synchronizing  both  their  phase-on-orbit  and  their  headings. 

To  solve  this  problem,  we  use  the  PF  algorithm  described 
in  the  previous  section  and  the  coordination  control  law 
proposed  in  Section  III.  Figure  2  presents  the  results  of 
this  experiment.  In  particular.  Figure  2a  shows  the  desired 
orbit  (black)  and  the  actual  trajectories  of  the  two  quadro¬ 
tors  (blue  and  red).  Since  the  two  UAVs  are  tasked  to 
follow  the  same  orbit,  a  phase-on-orbit  separation  is  required 
between  the  two  vehicles  to  avoid  collision.  This  separation 
is  specified  online  from  the  ground  station,  and  it  varies 
according  to  mission  requirements.  The  desired  phase-on- 
orbit  separation,  along  with  the  actual  phase  separation 
between  the  two  UAVs,  is  shown  in  Figure  2b.  In  this 
particular  scenario,  the  UAVS  are  initially  required  to  keep 
a  180-deg  phase  separation;  at  approximately  t  =  94  s,  the 
required  phase  separation  goes  down  to  90  deg;  the  two 
quadrotors  keep  this  configuration  for  about  14  s,  when  the 
required  phase  separation  goes  back  to  180  deg;  finally,  in 
the  last  part  of  the  experiment,  the  UAVs  are  required  to  keep 
a  phase  separation  of  270  deg. 

The  performance  of  the  PF  algorithm  is  illustrated  in 
Figure  2c  for  both  quadrotors.  As  can  be  seen  in  the  figure, 
the  PF  algorithm  is  able  to  steer  the  quadrotors  along  the 
circular  paths.  Note  that  the  deviations  appearing  at  times  94, 
112,  and  123  s  are  due  to  the  sudden  changes  in  desired  phase 
separation.  Finally,  Figure  2d  shows  the  convergence  of  71 
and  72  to  the  desired  rate  1,  as  well  as  the  convergence  of 
the  coordination  errors  to  a  neighborhood  of  zero. 

VI.  Conclusion 

This  paper  addressed  the  problem  of  steering  a  fleet  of 
quadrotor  UAVs  along  predefined  spatial  paths,  while  coor¬ 
dinating  with  each  other  according  to  mission  requirements. 
Cooperative  control  is  achieved  in  the  presence  of  time- 
varying  communication  networks,  and  stringent  temporal 
constraints.  The  constraints  include  collision-free  maneuvers 
(generated  off  line)  and  simultaneous  arrival  at  the  desired 


(b)  Desired  and  actual  phase  separation. 


(c)  PF  error. 

Derivative  of  shifted  time;  UAV1  and  UAV2 


0.2 


time,  s 


(d)  Coordination  errors. 

Fig.  2.  Flight  test  results  with  two  AR.Drone  UAVs. 

locations.  The  proposed  solution  solves  the  time-coordination 
problem  under  the  assumption  that  a  path-following  algo¬ 
rithm  -meeting  certain  stability  conditions-  is  given.  The 
synchronization  task  is  accomplished  by  adjusting  the  de¬ 
sired  position  and  velocity  of  each  vehicle.  The  exponential 
convergence  of  the  time-coordination  error  is  proven  using 
Lyapunov  theory.  An  illustrative  example  is  presented  to 
validate  the  convergence  of  the  algorithm.  To  this  end,  an  ad- 
hoc  path-following  algorithm  is  formulated  and  implemented 
for  two  AR.Drone  quadrotors.  The  results  obtained  validate 
the  theoretical  findings. 
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Appendix 

Sketch  of  the  proof  of  Lemma  1 
Assuming  that  the  PF  system  (7)  satisfies  Assumption  1,  and 
following  the  same  argument  as  in  [22,  Theorem  4.14],  there  exists 
a  Lyapunov  function  satisfying 

Ci\\xpf\\2  <Vpf  <  C2\\xpf\\"  ,  Vpf  <  —C3\\xpf\\~  ■  (27) 


In  addition,  consider  the  system 

4>{t)  =  —L4>(t) .  (28) 

Since  the  matrix  L  satisfies  the  PE  condition  in  (8),  we  can  use 
the  result  in  [23,  Lemma  5]  to  conclude  that  the  system  in  (28) 
is  GUES  (global  uniformly  exponentially  stable),  and  that  the 
following  bound  holds: 

mm  <  kxwmwe-^ 


with  k\  =  1  and  7x  >  7a  =  T^1+„aTyi  ■  This,  together 
with  [23,  Lemma  1]  or  a  similar  argument  as  the  one  in  [22, 
Theorem  4.14],  imply  that  there  exists  a  continuosly  differentiable, 
symmetric,  positive  definite  matrix  Pc{t)  that  satisfies  the  following 
inequalities: 


0  <  cil  =  (fl  <  Pc(t)  <  ff-I  =  Sal 
In  27a 

Pc  -  LPc  -  PCL  <  -C3I . 


(29) 


Next,  introducing  the  transformation 


X(t)  =  b£  +  Qz, 

the  time  coordination  states  can  be  redefined  as  xtc  =  [x  >z  ]T, 
with  dynamics 

fx  =  -fLx+fQLz-Qa(xPF) 

\z=  -( bl  -  fL)z  -  §  LQrx  -  a(xPF ) . 

At  this  point,  we  choose  a  Lyapunov  candidate  function 

V  =  Vpf  +  ^XTPcX  +  y  INI2’  (31) 

where  /3i  >  0,  and  Vpf  and  Pc  were  introduced  above.  After 
some  mathematical  computations,  and  using  (27),  (29),  and  (30), 
the  derivative  of  the  Lyapunov  function  becomes: 


V  <  -  (  c3  -  (fh  +  c2)d- 


Vd  r 


-  (  f -2 c2d 

2  Vd 


Vd  max 
Vd  max 


+  5 


+  5 
llxll2 


Half’ll 


—  Pi  I  b  —  n  —  2d 


max 

Vd  max 


Vd  r 


+  5 


INI 


+  xT(PcQL  -  /3iQL)z  . 


At  this  point,  one  can  show  that  there  exist  6,  d,  5,  c2,  and  C3  such 
that 


V  <  —2XV , 


ININ  < 


^max 


Vd  max 


where  A  was  defined  in  (12).  The  second  bound  above  is  required 
to  show  feasibility  of  the  commanded  speed  profile.  This  completes 
the  proof.  □ 


